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(54) THREE DIMENSIONAL MEASURING DEVICE 

(57)Abstract: 

PROBLEM TO BE SOLVED: To provide a three- 
dimensional measuring device capable of measuring a 
physical object in a short time without adjusting light in a 
free space in the case of transforming through the free 
space where noise, for example, reflected light, etc., 
exist, and without feedback control according to the 
result of imaging. 

SOLUTION: An attitude presumption part 2 presumes an 
attitude of a robot on the basis of the output from a 
sensor 1 . A filter angle decision part 4 decides the angle 
of filter by referring to an attitude/memory part for angle 
of filter 3 on the basis of the attitude presumed by the 
attitude presumption part 2. Angle of a polarizing filter 13 
is adjusted by activating a motor 6 for filter drive with 

control of a filter control part 5 on the basis of this decision. An imaging part 14 can image a 
line of cutting plane of light clearly by cutting unnecessary optic component with polarizing 
filter 13 adjusted to the most suitable angle as just described. 
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* NOTICES * 

Japan Patent Office is not responsible for any 
damages caused by the use of this translation. 

l.This document has been translated by computer. So the translation may not reflect the original 
precisely. 

2 **** shows the word which can not be translated. 
3. In the drawings, any words are not translated. 



CLAIMS 



[Claim(s)] 

[Claim 1] A three-dimensions metering device which is characterized by providing the following and 
which is carried in a mobile and measures distance to a measurement object object A luminescence 
means to irradiate slit light to a measurement object object An image pick-up means to picturize an 
optical cutting plane line which said slit light forms in said measurement object body surface A 
polarizing filter arranged between said image pick-up means and said measurement object object in the 
image pick-up direction by said image pick-up means A filter control means which controls a revolution 
of said polarizing filter according to change of a position of said mobile 

[Claim 2] A three-dimensions metering device according to claim 1 characterized by said filter control 
means controlling a revolution of said polarizing filter based on a position which is equipped with a 
position presumption means to presume a position of the mobile concerned based on an output from a 
sensor formed in said mobile, and this position presumption means presumed. 
[Claim 3] A three-dimensions metering device according to claim 1 or 2 characterized by said filter 
control means controlling a revolution of said polarizing filter based on angle information by which is 
equipped with a filter angle storage means to hold relation with an angle of said polarizing filter 
according to a position and this position of said mobile, and reading appearance was carried out from 
this filter angle storage means. 
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DETAILED DESCRIPTION 



[Detailed Description of the Invention] 
[0001] 

[The technical field to which invention belongs] This invention relates to the three-dimensions metering 
device which used the optical cutting method. It is related with the three-dimensions metering device 
formed in order to measure external environment in the autonomous mobile robot which moves with 
means, such as a bipedal locomotion, especially. 
[0002] 

[Description of the Prior Art] There is a method which uses an optical cutting method for one of the 
typical things of the three-dimensions metering device which measures the distance and its configuration 
to an object object by non-contact. A luminescence means by which the three-dimensions metering 
device using this optical cutting method irradiates slit light to an object object, This slit light has an 
image pick-up means to picturize the optical cutting plane line formed on the front face of an object 
object. The distance between these luminescence means and an image pick-up means, The distance to 
this object body surface is measured by geometric calculation based on the angle of the straight line 
which connects whenever [ illuminating-angle / of slit light ], and an image pick-up means and the 
location in which the optical cutting plane line on an object body surface is formed. Moreover, by 
changing whenever [ illuminating-angle / of slit light ] serially, or irradiating the slit light of two or more 
patterns at once, it can have not only an optical single cutting-plane-line top but an object object top, and 
field-breadth can be measured. 

[0003] In the metering device using the optical cutting method by such multi-slit light, since it became 
impossible for any light other than the slit light irradiated to measure by the ability not detecting an 
optical cutting plane line well when the reflected light is reflected to an image pick-up means in a 
measuring object object, enclosing the surroundings of an object object or adjusting the location and 
sense of lighting so that an unnecessary light may not enter was performed. 

[0004] Moreover, it sets to the three-dimensions configuration measuring device which measures the 
three-dimensions configuration of a device under test in the patent No. 3018887 official report using an 
optical cutting method. The polarizing filter arranged between the cameras and device under tests which 
picturize an optical cutting plane line, The technology of establishing a revolution means to rotate this 
polarizing filter centering on the optical axis of a camera, and a revolution means to control this 
revolution means so that whenever [ non-normal / of quantity of light distribution of the picturized 
optical cutting plane line ] serves as min is shown. In order according to the technology shown in this 
patent official report to control and measure so that a polarizing filter may be rotated and quantity of 
light distribution of an optical cutting plane line may approach a normal distribution most, it is supposed 
that the noise at the time of measurement can be lessened. 
[0005] 

[Problem(s) to be Solved by the Invention] In order to walk him around a slope, a stairway, etc. 
smoothly in a place in the man type autonomous mobile robot which moves with means, such as a 
bipedal locomotion, it becomes most important to measure the condition of a floor line to accuracy. 
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However, when the three-dimensions metering device stated with the above-mentioned conventional 
technology tends to be carried and it is going to measure the floor line and obstruction around a 
successive range, a wall surface, etc., the following problems arise. 

[0006] That is, in order for a robot to move in the inside of free space, and to also change the sense 
freely, and to suppress a reflect lump of the reflected light, it is [ be / when / measuring the distance to a 
floor line etc. with the three-dimensions metering device formed in the autonomous mobile robot, ] 
dramatically difficult to establish an enclosure in an object or to adjust the direction of lighting to it. 
[0007] Moreover, when the feedback control of adjusting the angle of rotation of a polarizing filter like 
the technology of patent No. 3018887 explained in the top using the picturized result is used, by the time 
it converges on the optimal angle of a polarizing filter, an image pick-up and quantity of light 
distribution analysis of multiple times must be repeated, and there is a problem that measurement takes 
time amount. 

[0008] This invention aims at offering the three-dimensions metering device which is made in 
consideration of the above situations, does not need adjustment of the lighting in the space when moving 
in the free space where a noise called the reflected light etc. exists, and does not need the feedback 
control based on an image pick-up result, but can measure an object object in a short time. 
[0009] 

[Means for Solving the Problem] A luminescence means for this invention to be a three-dimensions 
metering device which is carried in a mobile and measures distance to a measurement object object, and 
to irradiate slit light to a measurement object object in order to solve the above-mentioned technical 
problem, An image pick-up means to picturize an optical cutting plane line which said slit light forms in 
said measurement object body surface, A polarizing filter arranged between said image pick-up means 
and said measurement object object in the image pick-up direction by said image pick-up means, Let a 
three-dimensions metering device characterized by asking accuracy for distance to said measurement 
object object based on an image picturized by said image pick-up means be a summary by having a filter 
control means which controls a revolution of said polarizing filter according to change of a position of 
said mobile. 

[0010] Moreover, in a three-dimensions metering device of this invention, it has a position presumption 
means to presume a position of the mobile concerned based on an output from a sensor formed in said 
mobile, and is characterized by said filter control means controlling a revolution of said polarizing filter 
based on a position which this position presumption means presumed. Here, a sensor is a single or two 
or more sensors which are formed in order to detect a location of each portion of a mobile. This sensor is 
for example, an absolute mold encoder, and since it can measure a location simultaneously absolutely 
with the amount of actuation of a motor by this, it can obtain a location and an angle of each portion of a 
mobile. However, a sensor used here is not limited to an absolute mold encoder, for example, can also 
use G sensor, a rate sensor, 6 shaft sensor, etc. And a position presumption means presumes a position 
of a mobile based on correlation of a location of each portion of a mobile. 

[001 1] Moreover, in a three-dimensions metering device of this invention, it has a filter angle storage 
means to hold relation with an angle of said polarizing filter according to a position and this position of 
said mobile, and is characterized by said filter control means controlling a revolution of said polarizing 
filter based on angle information by which reading appearance was carried out from this filter angle 
storage means. 
[0012] 

[Embodiment of the Invention] Hereafter, 1 operation gestalt of this invention is explained with 
reference to a drawing. Drawing 1 is the block diagram showing the configuration of the three- 
dimensions metering device by this operation gestalt. This three-dimensions metering device is carried 
in the humanoid robot (mobile) which performs a bipedal locomotion, and can measure the floor line 
and wall surface of a migration place of this robot, an obstruction, etc. In drawing 1 , it is the test section 
to which a sign 50 measures these measurement object objects (floor line etc.), and 10 measures the 
distance to a measurement object object. The test section 10 has a control section 1 1, a light-emitting 
part 12 (luminescence means), a polarizing filter 13, and the image pick-up section 14 (image pick-up 
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means), and picturizes the optical cutting plane line which the multi-slit light which the light-emitting 
part 12 irradiated forms on the measurement object object 50 in the image pick-up section 14 through a 
polarizing filter 13 by control of a control section It 

[0013] Moreover, two or more sensors by which 1 was prepared for the robot, the position presumption 
section 2 presumes this robot's current position to be based on the output from a sensor 1, The position / 
filter angle storage section in which 3 holds the relation between a robot position and the angle of a 
polarizing filter 13 (filter angle storage means), The filter angle decision section which determines the 
filter angle which was suitable for the position when 4 read a position / filter angle storage section 3 
based on the robot position presumed by the position presumption section 2, The filter control section 
(filter control means) which controls the angle of a filter based on the angle as which the filter angle 
decision section 4 determined 5, and 6 are motors for filter actuation into which the angle of a polarizing 
filter 13 is changed by control of the filter control section 5. 

[0014] In addition, sensors 1 are specifically a rotary encoder, a rate sensor, G sensor, 6 shaft sensor, 
etc., and each direction component of the force or torque which acts on a sensor can be detected here. 
And direct detection of the condition of two or more joints of a robot can be carried out according to an 
individual by forming these sensors 1 in a robot's each part of the key point. And the position 
presumption section 2 presumes a robot's position from the relation of the positional information of each 
part of a robot. 

[0015] Next, an operation of the polarizing filter 13 in this operation gestalt is explained. Drawing 2 is 
the cross section showing the image pick-up condition of an optical cutting plane line. As shown in (a) 
of drawing 2 , and (b), the polarizing filter 13 is formed in the measurement object object 50 side of the 
image pick-up section 14 in the image pick-up direction. Moreover, the light-emitting part 12 is formed 
in the part which kept a predetermined distance from the image pick-up section 14. 
[0016] The noise light (A) from the outside reflects in the measurement object object 50, and drawing 2 
(a) shows the condition which this reflected light (B) passes a polarizing filter 13, and carries out 
incidence to the image pick-up section 14. Although the above-mentioned noise light (A) has all plane 
of polarization at this time, the reflected light (B) from the measurement object object 50 has single 
plane of polarization. It becomes perfect polarization when the incident angle and angle of reflection 
over the measuring object body 50 turn into a brewster's angle especially. In the case of a floor line, an 
incident angle and angle of reflection become with perfect polarization at about 45 degrees about. On 
the other hand, the slit light (C) irradiated from the light-emitting part 12 reflects in the measurement 
object object 50, and drawing 2 (b) shows the condition which this reflected light (D) passes a polarizing 
filter 13, and carries out incidence to the image pick-up section 14. Such the reflected light (D) has the 
feature of not polarizing. 

[0017] Then, a noise component is removed by adjusting the angle of a polarizing filter 13 so that the 
reflected light (C) which has single plane of polarization may be cut, and it becomes possible to 
picturize vividly the optical cutting plane line (D) irradiated by the light-emitting part 12. Moreover, 
since the image pick-up direction by the image pick-up section 14 changes by a robot's position, the 
optimal filter angle according to each position is beforehand memorized in a position / filter angle 
storage section 3, the motor 6 for filter actuation is operated and the angle of a polarizing filter 13 is 
adjusted so that it may become the filter angle which the filter angle decision section 4 determined based 
on this content of storage. 

[0018] Next, the procedure of adjusting the angle of a filter based on the output from a sensor is 
explained. Drawing 3 is a flow chart which shows a series of procedure until it measures by adjusting 
the angle of a filter based on the output of a sensor 1 in this operation gestalt. Hereafter, order is 
explained later on, referring to drawing 3 . 

[0019] First, in step SI, the output from the various sensors (1) formed in a robot's each part is 
incorporated. Next, in step S2, the position of the robot whole body is presumed based on the sensor 
value incorporated at step SI. Next, in step S3, the filter angle corresponding to the robot position 
presumed at step S2 is read from a position / filter angle storage section (3). Next, in step S4, in order to 
make it the filter angle acquired at step S3, the amount of migration angles from the current angular 
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position of a polarizing filter (13) is determined. 

[0020] Next, in step S5, a polarizing filter (13) is rotated by operating the motor for filter actuation (6). 
Next, the angular position of a polarizing filter (13) is detected in step S6. And in step S7, it judges 
whether the migration angle of a polarizing filter (13) reached the amount of migration angles 
determined by step S4. If it has reached and the following step S8 is not progressed and reached, it 
returns to step S5. Thus, completion of accommodation of the angle of a polarizing filter (13) measures 
a measurement object object in step S8 using an optical cutting method. 

[0021] As explained in the top, in order according to this operation gestalt to rotate a polarizing filter 
according to a robot's position and to adjust an angle, effect of being moved and crowded of the 
reflected light from the outside is minimum-ized, and it becomes possible to perform always exact 
measurement. Moreover, since it is the feedforward control which does not need to use the feedback 
control which adjusts the angle of a polarizing filter based on the analysis result of the picturized image, 
for example, presumes a robot's position based on the detection result by the sensor, reads the filter 
angle memorized according to the position, and adjusts the angle of a polarizing filter according to this 
operation gestalt, there is an advantage that the time amount which the decision of a filter angle takes is 
short. Therefore, the three-dimensions metering device by this operation gestalt is effective especially in 
the use which needs real time measurement like the robot which works while moving. 
[0022] In addition, an above-mentioned three-dimensions metering device may be realized using a 
computer system. In that case, it is made to perform the above-mentioned processing by recording the 
process of processings, such as the position presumption section mentioned above, the filter angle 
decision section, and a filter control section, on the record medium in which computer reading in the 
form of a program is possible, and a computer's reading this program and executing it. The record 
medium in which computer reading is possible here means a floppy (registered trademark) disk, a 
magneto-optic disk, CD-ROM, DVD-ROM, a magnetic hard disk, semiconductor memory, etc. 
[0023] As mentioned above, although the operation gestalt of this invention has been explained in full 
detail with reference to a drawing, a concrete configuration is not restricted to these operation gestalten, 
and layout of the range which does not deviate from the summary of this invention etc. is included. 
[0024] 

[Effect of the Invention] As explained above, according to this invention, a three-dimensions metering 
device Since it has the polarizing filter arranged between an image pick-up means and a measurement 
object object in the image pick-up direction by the image pick-up means, and the filter control means 
which controls a revolution of a polarizing filter according to change of the position of a mobile, The 
reflected light which is emitted from the outside, reflects in a measurement object object, and is reflected 
with the above-mentioned polarizing filter can be cut, an optical cutting plane line can be detected 
vividly, and exact measurement can be performed. Moreover, since a filter angle can be appropriately 
adjusted according to change of the position even if the position of a mobile changes, exact 
measurement can always be performed. Furthermore, since this accommodation is performed by 
feedforward control, time amount like [ in the case of performing feedback control using an image pick- 
up result ] cannot be required, but a filter angle can be doubled with the optimal location in a short time. 
[0025] Moreover, since it has a position presumption means to presume the position of the mobile 
concerned based on the output from various sensors called G sensor, a rate sensor, 6 shaft sensor, etc. 
which were formed in the mobile according to this invention, it becomes possible to detect change of the 
position of a mobile concretely. 

[0026] Moreover, since it has the position / a filter angle storage means to hold relation with the angle of 
the polarizing filter according to the position and this position of a mobile according to this invention, 
even if it does not perform complicated computation etc. especially, it becomes possible in a short time 
to acquire the desired value of the angle of a polarizing filter. 
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DRAWINGS 



[Drawing 1] 
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[Drawing 2] 
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